% batch 1
[error_pose1, error_map1, mapAnswer1] = fastslam3d(landmark,action);